float32[] joint
float32 speed
uint8 trajectory_connect